#include "bsp_motor.h"
#include "bsp_Graysensor.h"
#include "getStatus.h"
#include "Strategy.h"
#include "ControlMethod.h"

int getSerial_int(void);

int input_int = 0;

void setup()
{
  Serial.begin(38400);
  Graysensor_Init();
  Motor_Init();
  delay(1000);
}

void loop()
{
//  float a[4];
//  getGray(a,0b1111);
//  for (int i = 0;i<4;i++)
//  {
//   Serial.print("  ");
//   Serial.print("i:");
//   Serial.print(i);
//   Serial.print("  ");
//   Serial.print(a[i]);
//  }
//  Serial.println();
  

//  while(!isConfine_Gray())
//  {
//    Forward(MIDSPEED);  
//  }
//  Outback();

Forward(MIDSPEED);
//turnRight_FW(MIDSPEED,MID_OFFSET);
}

/**
 * @brief 得到串口监视器的输入值 
 * @param void
 * @return int
 * */
int getSerial_int()
{

  if (Serial.available())
  {
    input_int = Serial.parseInt();
  }
  return input_int;
}
